#!/usr/bin/env python3
# -*- coding:utf-8 -*-
# @Author: renjin@bit.edu.cn
# @Date  : 2024-08-28

import cv2

from spirems import Service, def_msg
import threading
import time


def callback_f(msg):
    print(msg)
    res_msg = def_msg('std_msgs::String')
    res_msg['data'] = msg['data'][:-1] + ', too!'
    return res_msg


if __name__ == '__main__':
    ss = Service('/service1', 'std_msgs::String', 'std_msgs::String', callback_f)

